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MODELING  AND  SIMULATION  OF  A  FIN  ACTUATION  SYSTEM 


SUMMARY 

A  study  was  begun  to  model  and  simulate  a  missile  fin  actuation  system 
driven  by  a  brushless  dc  motor.  This  report  describes  preliminary  results  in 
which  the  motor,  drive-train,  and  load  were  modeled  using  the  usual  linear 
descriptions.  Simulation  of  system  response  to  step  and  frequency  inputs  was 
accomplished  using  the  Continuous  System  Modeling  Program. 

Initial  qualitative  results  shew  that  the  model  successfully  predicts  the 
effects  expected  from  variations  in  load  and  damping.  Further  evaluation  of 
the  model  and  possible  refinements  will  require  the  availability  of  test  data 
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LIST  OF  SYMBOLS 


Bjr,  Coefficient  of  viscous  friction  of  the  motor  (rad/sec) 
Ea  Control  input  voltage 

Fb  Generated  voltage  (hack  emf) 

Fs  Force  acting  on  the  hall  screw 
Is  Stator  current 

Jc  Moment  of  inertia  of  the  crank 

Jm  Moment  of  inertia  of  motor  shaft 

Js2  Moment  of  inertia  of  output  shaft 

Kb  Back  emf  constant 

Torcjue  constant 
L  Lead  of  ball  screw 

Ls  Inductance  of  the  stator  windings 
Mb  Fin  hinge  moment 

Ms  Mass  of  the  hall  screw 

N  Gear  ratio 

P  Pitch 

Rg  Resistance  of  2  stator  windings 

Tf  Sum  of  the  friction  forces  acting  on  the  actuator 

Tm  Torque  generated  by  the  motor 

Tl  Torque  acting  on  the  motor  output  shaft 

X  Linear  displacement  of  the  ball  screw 

0m  Angular  displacement  of  the  motor  shaft 

0n  Angular  displacement  of  the  fin 


INTRODUCTION 


Recent  improvements  in  rare-earth  nagnetic  naterials  for  use  in  brushless 
dc  motors  have  allowed  reconsideration  of  electro-mechanical  actuator  systems 
for  applications  requiring  very  high  ratios  of  torque-to-inertia.  The 
investigation  discussed  herein  has  been  concerned  with  characterizing 
mathematically  the  dynamical  features  of  a  missile  fin  actuation  system,  from 
the  input  to  the  brushless  dc  motor  to  the  output  shaft  of  the  mechanical 
actuator.  The  physical  model  is  based  upon  an  existing  prototype  actuator 
currently  under  evaluation  at  the  Naval  Weapons  Center,  China  Lake, 

California. 

In  general,  brushless  dc  motors  produce  torque  through  the  interaction  of 

a  nagnetic  field  generated  by  a  permanent  nagnet  rotor  and  a  dc  generated 

magnetic  field  in  the  stator.  The  rotating  permanent  magnet  eliminates  the 

rotating  armature  and  the  mechanical  wear  normally  associated  with  brushes. 

These  motors  fall  in  the  class  of  Permanent  Magnet  Motors  and  enjoy  certain 

advantages  over  wound-field  types  such  as: 

"...linear  torque-speed  characteristics,  high  stall  (accelerating)  torque, 
no  need  for  electric  pcwer  to  generate  the  magnetic  flux  and  a  smaller 
frame  and  lighter  motor  for  a  given  output  pcwer"  (1). 

Additionally,  the  brushless  dc  motor  is  characterized  by: 

"...controllability  over  a  wide  range  of  speeds,  capable  of  rapid 
acceleration  and  deceleration,  convenient  control  of  shaft  speed  and 
position,  no  mechanical  wear  problem  due  to  corrmutation  and  better  heat 
dissipation  arrangement"  [1] . 

The  fundamental  requirement  of  an  electro-mechanical  actuator  control 
system  is  to  provide  torque  to  an  output  shaft,  sense  the  position  of  the 
shaft  and  adjust  the  torque  to  balance  the  load  when  the  desired  position  is 
reached.  This  nust  be  accomplished  with  a  minimum  of  frictional  resistance 
and  delays  associated  with  the  inertia  of  the  mechanical  components.  Effects 
of  viscous,  static  and  coulomb  friction,  together  with  the  torque  required  to 


-1- 


accelerate  the  mechanical  components  of  the  system,  lead  to  a  reduction  in 
torque  available  at  the  output  shaft  and  an  associated  reduction  in  system 
perf ormance . 


One  approach  to  the  analysis  of  the  electro-mechanical  actuator  system  has 
been  to  divide  the  system  into  two  sequential  problem  areas.  The  first  deals 
with  the  dynamic  analysis  of  the  brushless  dc  motor  and  development  of  the 
transfer  function  necessary  to  duplicate  actual  steady-state  and  transient 
performance.  The  second  area  deals  with  modeling  the  mechanical  system 
elements,  taking  as  input  the  dc  motor  shaft  angular  acceleration  predicted  by 
the  motor  analysis.  The  mechanical  system  must  be  modeled  considering  the 
effects  of  friction  and  inertia  and  translating  the  rotational  motion  of  the 
brushless  dc  motor  shaft  to  the  output  shaft  of  the  actuator  for  application 
to  missile  maneuvering  control.  This  report  documents  the  results  obtained 
from  a  study  that  has  placed  primary  emphasis  upon  the  latter  problem  area  - 
the  modeling  of  the  mechanical  drive-train  leading  to  the  fin  shaft  [2).  The 
influences  of  various  design  aspects  of  brushless  dc  motors  are  not  given 
detailed  attention  here,  but  such  ratters  have  been  studied  in  parallel 
investigations  [3,  4] . 

The  remainder  of  this  report  presents  the  results  of  attempts  to  formulate 
a  mathematical  model  of  a  brushless  dc  motor  and  a  mechanical  actuator  as 
might  he  installed  on  a  Navy  tactical  missile.  The  model  has  been  implemented 
in  a  computer  program  so  that  parametric  studies  ray  be  conducted  to  determine 
output  characteristics  (torque,  speed,  acceleration)  as  functions  of  input 
forms  and  design  options.  Additionally,  the  modular  format  used  in  CSMP1  will 
facilitate  incorporation  of  future  technology  and  allow  inputs  for  use  in  both 
design  and  analysis. 

l  The  Continuous  System  Modeling  Program  (CSMP)  is  a  program  especially 
developed  by  IBM  to  allow  users  to  simulate  physical  systems  with  a  minimum 
of  programing  difficulty.  Details  are  provided,  for  instance,  in  Ref.  5. 
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THEORY  AND  ANALYSIS 

GENERAL 

The  system  is  viewed  as  a  position  control  device  to  maintain  an  output 
angle  under  an  applied  hinge  moment  due  to  aerodynamic  forces  on  a  fin  or 
aileron.  The  motor  is  a  permanent  magnet  dc  motor  with  feedback  in  the  form 
of  back  emf  proportional  to  the  angular  velocity  of  the  motor.  The  block 
diagram  of  the  dc  motor  is  shown  in  Fig.  1  [6].  The  mechanical  actuator  and 
drive  train,  «  currently  envisioned,  introduce  various  inertial  and  damping 
loads  together  with  an  aerodynamic  force  and  its  associated  fin  hinge  moment 
that  must  be  overcome  to  produce  ouput  motion.  An  operational  block  diagram 
of  the  load  torque  is  shown  in  Fig.  2  where  the  hinge  moment  and  motor  shaft 
angular  acceleration  are  viewed  as  inputs  to  the  drive  train.  Figure  3  is  a 
schematic  of  the  drive  train  which,  as  presently  constituted,  includes  the 
motor  shaft  (leadscrew),  ball  screw  assembly,  and  the  crank  which  is  keyed  to 
the  output  (fin)  shaft.  Inertial  loads  are  considered  individually  within 
three  major  subdivisions  of  the  actuator;  the  ouput  shaft  to  crank,  crank  to 
ball  screw,  and  ball  screw  to  leadscrew. 


E 

a 


Figure  1.  Standardized  Block  Diagram  of  a  DC  Motor 


. .  i 
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MOTOR  ANALYSIS 


The  voltage  drop  across  the  stator  windings  of  a  permanent  magnet 
brushless  dc  motor  may  be  -written 

Ea  -  Eb  =  Lg  ^  +  Rgls  (1) 

and  the  current  leads  to  a  developed  torque  given  by 

Tn  =  KiLs  (2) 

This  torque  oust  overcome  frictional  loads  and  inertias  reflected  to  the  motor 
output  shaft  while  at  the  same  time  supplying  a  demanded  load  torque  Tp  so 
that 

^m  =  ^m  ^m  +  ^m  +  ( 3 ) 

( In  the  simple  model  developed  herein  we  have  assumed  that  spring  loads  due  to 
elasticity  in  the  drive  train  are  negligible.)  The  back  emf  is  approximated 
as  proportional  to  the  motor  speed  (the  electrical  counterpart  of  viscous 
friction)  with  the  result  that 

Eb  Kb  ^'m  ^  ^ 

Equations  (1)  -  (4)  may  be  viewed  as  governing  the  time  variation  of  the 
variables  E^,  Is,  Tm,  and  in  response  to  input  voltage  Ea  and  constrained 
by  the  load  torque  Tl«  The  internal  motor  parameters  are  Lg,  Rg,  Kj_ ,  and  K^, 
while  the  mechanical  features  of  the  motor  are  characterized  by  Jm  and  Bp,. 

The  various  functional  relationships  are  illustrated  in  Fig.  1. 

LOAD  ANALYSIS 

The  power  transmission  system  is  illustrated  in  Fig.  3  and  contains  a  ball 
screw  that  converts  the  axial  component,  Fs,  of  the  force  required  by  the  load 


on  the  hall  screw  into  a  load  torque  acting  on  the  motor  shaft  (leadscrew). 
The  conversion  is  given  by 

Tl  =  (FgL)  /  2tt  (5) 

where  L  is  the  lead  (distance  the  hall  screw  moves  parallel  to  the  axis  of  the 
leadscrew  for  one  revolution  of  the  leadscrew).  This  relationship,  the 
development  of  which  is  discussed  further  in  Ref.  2,  requires  the  assumption 
of  negligible  frictional  effects  in  the  ball  screw.  The  force  transmitted  as 
torque  through  the  action  of  the  ball  screw  is  parallel  to  the  axis  of  the 
leadscrew  only  when  the  crank  is  orthogonal  to  the  leadscrew.  As  a  result,  a 
nonlinear  relationship  exists  between  the  force  acting  on  the  ball  screw  and 
the  torque  reflected  back  through  the  system  from  the  output  shaft  (see 
Appendix  A) . 

Pitch  P  is  the  ratio  of  the  linear  displacement  X  of  the  ball  screw  to  the 
angular  displacement  0m  of  the  motor  shaft.  The  gear  ratio  N  is  defined  here 
as  the  ratio  of  the  angular  displacement  of  the  motor  shaft  to  the  angular 
displacement  0o  of  the  output  shaft.  The  relationship  between  pitch  and  gear 
ratio,  for  a  given  drive  train  geometry,  is  also  developed  in  Appendix  A. 

The  sum  Fs  of  the  load  forces  acting  on  the  ball  screw  depends  upon  the 
fin  hinge  moment  due  to  the  aerodynamic  forces  acting  on  the  aileron,  the 
moment  of  inertia  of  the  output  shaft  Js2r  the  moment  of  inertia  of  the  crank 
Jc,  the  angular  acceleration  0Q  of  the  output  shaft  (assumed  to  be  the  same 
as  the  crank,  i.e.,  the  output  shaft  is  of  infinite  stiffness),  and  the 
mass  Mg  and  linear  acceleration  X  of  the  ball  screw. 


Fg  =  MSX  +  [(JCG0  +  Js2^o  +  Mh'  /  (Rcos0o)] 


(6) 


PRELIMINARY  RESULTS  AND  CONCLUSIONS 


Validation  in  rathematical  modeling  requires  a  comparison  between  response 
predictions  obtained  through  simulation  and  data  produced  as  a  result  of 
experiments.  At  this  writing,  test  data  have  not  become  available  for  the 
electro-mechanical  actuator  modeled  in  this  study  and,  therefore,  the 
precision  of  the  model's  representation  of  reality  remains  untested.  For  the 
present,  therefore,  the  "credibility"  of  the  model  must  be  based  on  the 
reasonableness  of  the  model's  dependency  upon  certain  key  variables  such  as 
the  viscous  friction  of  the  motor  and  the  level  of  the  applied  load. 

Figure  4  shows  the  predicted  response  to  a  30-volt  step  input  under  zero 
applied  load  using  the  ranufacturer 's  specifications1  for  the  viscous  friction 
of  the  motor.  For  comparison,  a  90-percent  reduction  in  the  viscous  friction 
of  the  motor  under  the  same  input  and  load  conditions  produces  the  slightly 
underdamped  response  shown  in  Fig.  4.  A  decrease  in  the  viscous  friction  of 
the  motor  produces  the  expected  change  in  the  output  response,  but  the  system 
remains  highly  stable  due  to  the  back-emf  effect  in  the  motor. 

For  further  comparison.  Figs.  5  through  7  were  obtained  using  a  30-volt 
step  input  and  manufacturer's  specification  for  the  viscous  friction  of  the 
motor.  Figure  5  depicts  the  fin  angle  versus  time  for  this  nominally-damped 
system  under  varying  loads.  As  expected,  the  fin  angle  produced  for  a  given 
time  decreases  with  an  increase  in  the  output  load.  This  is  in  agreement  with 
Fig.  6  where  the  steady-state  fin  rate  is  seen  to  decrease  with  an  increased 
load.  The  steady  state  rate  response  for  the  zero  load  condition,  obtained 
from  Eq.  (8),  is  given  by 


1  Numerical  values  used  to  define  the  nominal  design  are  listed  in  Appendix  R, 
Figure  Rl. 


Figure  5.  Fin  Angle  Response  to  Step  Input;  Various  Hinge  Moments 


Figure  6.  Fin  Rate  Response  to  Step  Input;  Various  Hinge  Moments 
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Cn  =  Kj  Ra  /  (NfRgR^  +  K^K^)]  (steady  state) 
and  for  the  nominal  case  studied  here  a  value  of  203.3  degrees/second  is 
obtained,  as  indicated  in  the  no-load  curve  of  Fig.  6.  The  frequency  response 
results  shewn  in  Fig.  7  were  obtained  using  zero  applied  load  and  nominal 
design  conditions.  The  nominal  second-order  system  response  in  Fig.  4 
illustrates  reasonable  time-domain  specifications  for  delay  time  (Tp  =  0.0020 
seconds),  rise  time  (Tr  +  0.0055  seconds)  and  settling  time  (Ts  =  0.0090 
seconds).  Corresponding  frequency  response  characteristics,  illustrated  in 
Fig.  7,  are  bandwidth  (BW  =  159  Hz),  cutoff  frequency  ( =  159  Hz)  and 
resonant  frequency  (o>p  =  28  Hz). 

The  program  currently  models  a  second  order  open-loop  system  providing  an 
output  velocity  dependent  upon  an  input  voltage.  Two  considerations  were 
deliberately  neglected  in  order  to  simplify  the  initial  model  construction, 
mechanical  backlash  between  the  leadscrew  and  ball  screw  and  torsional 
deflection  in  the  ouput  shaft.  Inclusion  of  both  within  the  NOSORT  section  of 
the  CSMP  code  would  bring  the  model  in  closer  alignment  with  the  physical 
system.  In  addition,  incorporation  of  angular  position  control  in  the  form 
of  position  feedback  added  as  a  macro  to  the  original  code  would  increase  the 
program  utility.  Determination  of  the  extent  to  which  these  and  other 
refinements  are  necessary  nust  await  the  availability  of  test  data. 
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APPENDIX  A 


CRANK/RALL  SCREW  TRANSFER 

The  physical  arrangement  of  the  leadscrew,  ball  screw,  crank  and  output 
shaft  is  illustrated  in  Fig.  3.  The  output  load  which  appears  as  a  torrjue 
on  the  output  shaft,  is  transmitted  as  a  force  acting  with  the  moment  arm 
created  by  the  crank.  When  the  crank  is  orthogonal  to  the  leadscrew,  the 
force  acting  on  the  hell  screw  as  a  result  of  the  output  load  is  parallel  to 
the  axis  of  the  leadscrew  and  is  transmitted  to  the  leadscrew  as  shown  in  the 
sketch  below.  However,  in  order  to  affect  output  shaft  rotation,  the  crank  is 


generally  not  orthogonal  to  the  leadscrew  and  the  force  vector  acting  on  the 
ball  screw  is  no  longer  parallel  to  the  axis  of  the  leadscrew.  The  force 
vector  acting  on  the  hall  screw  is  represented  as  an  axial  force  Fs  and  a 
transverse  force  Ft  in  the  sketch.  The  axial  force  may  be  written  as 

Fs  =  Mh  /  (Rcos0o) 

where  R  is  the  length  of  the  crank  measured  from  the  axis  of  the  output  shaft 
to  the  axis  of  the  leadscrew  and  °o  is  the  output  shaft  orientation  measured 
such  that  0o  is  zero  when  the  two  axes  are  perpendicular.  The  result 
effectively  shortens  the  moment  arm  generated  by  the  crank  and  increases  the 
axial  force  acting  on  the  ballscrew  for  a  given  output  load. 

GEAR  RATIO 

The  gear  ratio  N  is  defined  as  the  ratio  of  the  angle  turned  by  the 
motor  shaft  to  the  angle  0o  turned  by  the  output  shaft.  In  differential  form, 

N  =  dOm  /  d0o 

and,  in  terms  of  ball  screw  displacement  X, 

N  =  (dbm  /  dX)  (dX  /  d0o) 

The  first  term  in  this  expression  is  the  reciprocal  of  the  pitch  of  the  ball 
screw  and  the  second  term  is  related  to  the  geometry  of  the  drive  train 
following  the  ball  screw. 

The  geometry  illustrated  in  Fig.  3  leads  to  the  relationship 
X2  =  A2  +  R2  -  2AR  cosat  (Al) 

where  a  is  the  orientation  of  the  crank  arm  measured  relative  to  a  fixed 
reference  frame.  Taking  the  derivative  of  this  expression  with  respect  to  a 
dX  /  da  =  AR  sina  /  X 


-A  2- 


and  after  elimination  of  sina  by  means  of  Eq.  (Al) 

dX/dci  =  [  ( 2AR)  2  -  (A2  +  R2  -  X2)2]  1/2  /  2X  (A2 

This  expression  has  a  raximum  at  X  =  Xref  =  (A2  -  R2) 1/2  which  corresponds  to 
the  configuration  when  the  output  crank  and  motor  shaft  are  perpendicular, 
that  is,  when  0o  =  0.  For  the  design  presently  under  consideration, 

A  =  6.875  in.  and  R  =  1.887  in.  so  that  Xref  =  6.6110  in.  The  corresponding 
value  of  a  is  aref  =  tan-1  (Xref/R)  =  74.07  degrees.  For  any  given  design 
this  is  a  fixed  value  such  that  a  =  a^f  +  0o  and  dX/dct  =  dX/d0o.  The  gear 
ratio  is  N  =  (dX/d0o)/P  so  that  with  Eq.  (A2) : 

M  =  [ ( 2AR) 2  -  (A2  +  R2  -  X2)2]1/2  /  2XP 

The  maximum  value  of  N  occurs  at  X  =  Xj-gf  and  is  given  by  N^x  =  R/P,  (74.1 
for  the  present  design). 

Figure  Al  shows  the  variation  of  the  gear  ratio  around  the  maximum  value 
in  terms  of  ball  screw  position  X  and  Fig.  A2  illustrates  the  effect  of  the 
nonlinearity  for  the  present  design  over  a  range  of  fin  deflections. 

Operation  of  the  actuator  within  90  percent  of  the  maximum  gear  ratio  would 
allow  a  fin  deflection  of  about  25  degrees  relative  to  0o. 
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INITIAL 
CONSTANT  EM 
A  =  6. 875, 
KB  =  0. 1 l2, 
PAL  A METER  TF 
M  H  1  =  0.0, 


=  0.000  15,  JM  =  0.001,  ? 
E  =  1.337.  KI  =  15.9,  .  . 
LN  =  6.6110 


--  0. 
L3  = 
IIK  = 


0,  JC  =  0.30 

0.0016.  ... 
0.0,  ERROR 


JS  2  = 

0.00  1 


=  0.025 
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♦A  DIMENSION  OF  ACTUATOR  ARRANGEMENT  IN 

*  AM  ANGULAR  ACCELERATION  OF  THE  MOTOR  SHAFT  RAD/SEC*2 

*  AO  ANGULAR  ACCELERATION  OF  THE  OUTPUT  FIN  RAD/SEC«:2 

*  A  1  LS/R3  —  THE  INVERSE  ELECTRICAL  TIME  CONSTANT 
*A2  JM/BM  --  THE  INVERSE  MECH  ANIC AL  TIME  CONSTANT 
* BM  COEFFICIENT  OF  VISCOUS  FRICTION  OZ- 1 N/ FAD/SEC 

*  DM  ANGULAR  DISPLACEMENT  OF  THE  MOTOR  SHAFT  BAD 

*  DO  ANGULAR  DISPLACEMENT  OF  THE  FIN  RAD 

♦FOFTN  FUNCTION  OF  NET  TORQUE  OF  MOTOR  OZ-IN 

♦IS  CURRENT  GENERATED  IN  THE  STATOR  WINDINGS  AMPERES 

*JC  MOMENT  OF  INERTIA  OF  THE  CRANK  OZ-IN-SEC22 

*  JM  MOMENT  OF  INERTIA  OF  MOTOR  SHAFT  OZ-IN-SEC*2 

*  JS  2  MOMENT  OF  INERTIA  OF  OUTPUT  SHAFT  OZ-IK-SEC*2 

*  KB  BACK  E1F  CONSTANT  VOLTS/ (R A  D/SEC) 

♦KI  TORQUE  CONSTANT  (OZ-I N) /A MPERE 

* L  DISPLACEMENT  OF  BALL  SCREW  FROM  MOTOR  ANCHOR  POINT  IN 

*LS  INDUCTANCE  OF  THE  STATOR  WINDINGS  H 

♦LN  LINKAGE  NULL;  DISPLACEMENT  OF  BALL  SCREW  SUCH  THAT 

*  CRANK  IS  PERPENDICULAR  TO  MOTOR  SHAFT  IN 

*MH  FIN  HUGE  MOMENT  OZ-IN 

* M  MASS  O?  THE  BALL  SCREW  OZ 

*  N  GEAR  RATIO 

*P  PITCH  IN/RAD 

♦R  DIMENSION  OF  ACTUATOR  ARRANGEMENT  IN 

♦R3  RESISTANCE  OF  2  STATOR  WINDINGS  OHMS 

♦TF  SUM  OF  THE  FRICTION  FORCES  ACTING  ON  THE  BALL  SCREW  OZ- 

*TM  TORQUE  GENERATED  BY  MOTOR  OZ-IN 

*TS 1  TORQUE  ACTING  ON  THE  BALL  SCREW  DUE  TO  THE  PRODUCT  OF 

*  MASS  AND  THE  ACCELERATION  OF  THE  BALL  SCREW  OZ-IN 

♦VEMF  BACK  E  IF  VOLTS 

♦VIN  APPLIED  VOLTAGE  VOLT' 

♦VC  ANGULAR  VELOCITY  OF  THE  FIN  EAD/SEC 

♦KM  ANGULA1  VELOCITY  OF  MOTOR  SHAFT  PAD/SEC 
LINEAR  DISPLACEMENT  OF  THE  BALL  SCREW  IN 
♦XI  LINEAR  VELOCITY  OF  THE  BALL  SCREW  I N/S EC 

* X2  LINEAL  ACCELERATION  OF  THE  BAIL  SCREW  IN/5EC22 


NOSORT 

KE=  KD/ 1 0 . 

PI-2. 0  ♦  A  R  3 1  i  (1.000000) 

A  1  =  LS  /  F.  i 
A  2  =  JM  /  B 1 
THRST  =  0.0 
J  F AC  =  0.0 

* - INTEGRATION  METHOD 

METHOD  RKSFX 


DYN  AMIC 

* - MOTOR  PROGRAM 

V  I F  =  30.0  ♦  STEP  (0.0) 

VIB  =  0.0 

VIN  =  VIF  ♦  VIB 

V  IN  1  =  VIN  -  VEMF 
ISSS  =  VIN  1  *  (1.0/RS) 


mp  rp-v  ;pam  LIST  IDG  (continued) 


♦  --CURRENT  IS  GENERATED  IN  AH  PERES  — 

I S  =  REALPL  (0.0, A  1 ,ISSS) 

*  - ACTUATOR  PROGRAM - 

♦— TM  IS  GENERATED  IN  CZ-IN-- 

TM  =  IS  ♦  K I 
WM  =  INTGR  L(0.0,AM) 

DM  =  1NT3RL  0.0, WM) 

AC  =  AM  /  M 

vo  =  w:i  /  n 

DO  =  DM  /  M 
D  0 1  =  C05(DD) 

X  2  =  AH  *  P 
X  =  DM  *  P 
L  =  LN  ♦  X 

DL  =  SQRT ( ( 2  *A*R) **2-  (A**2+R**2-L**2)**2) 

H  =  DL  /  2*L*Pj 
TS  1  =  M  *  X  2  *  P 

TC  =  JC  *  AJ*  ( 1 . 0/ (  R*DO 1 )  )  *  P 
TO  =  JS2  *  AO  ♦  {  1 .0/ (R*D01)  ) 

ID  =  BM  *  W  1 

MH  =  MH 1  ♦  (  1.0/ (R*DC  1)  )  *  P 
TL  =  TS1  ic  +  TO  +  TF  ♦  TD  + 

TN2  =  TNI  *  (1.0/BM) 

♦--FOR  COMPARISON  WITH  WM  GENERATED  THRU  INTGRI  AM- 
WM1  =  REALPi.  (0.0.  A2.TN2) 

♦--CONVERSION  rACTOR  RAD/SEC  TO  RPM — 

W MRPM  =  WM  *  (30. /FI) 

V  EMF  =  WM  *  KB 

VODEG  =  VO  ♦  (180.0/PI) 

DODEG  =  DO  *  (180. 0/P  l\ 

* — COUNTS  NUMBER  OF  ROTATIONS  OF  MOTOR  SHAFT — 
THCON  =  THRU 

* — CONVERSION  FACTOR  (RAD/SEC) *OZ-I N  TO  WATTS — 

P  WR  =  WM  *  CM  *  .00706155 


I))  ♦  P 
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PROCEDURE  TH1=FWD8WD  (VIN.TfJ.TL) 
TNI  =  IMPL  ( ITN,  ERROR, FOFTIJ) 

AM  =  TNI  /  JM 
IF  (VIN.LT.  0. 0)  GO  TO  10 
r OF TN  =  T1  -  TL 
GO  TO  15 

10  FOFTN  =  T1  ♦  TL 
15  CONTINUE 
ENDPROC ED UR E 


PROCEDURE  THR  31=RESET  (JFAC,DMDEG) 
TS  =  JFAC  *  360.0 
THR3T  =  D.1D3G-  TS 
I F (THRST. LT. 360. 0)  GO  TO  40 
JFAC  =  JFAC  ♦  1.0 
4  0  CONTINUE 
ENDFROCEDURE 


♦--DEBUG  FROC3DURE-- 

♦  OSCRT 

*  CALL  DEBUG  (-5,0) 

TERMINAL 

TITLE  EASIC  EM  ACTUATOR  SYSTEM 
T IMER  FINTI  1  =  .040 
OUTPUT  VO  DEi.  DODEG 

*  PRINT  VODEG, CODEC 

LABEL  MOTOR  SPEED  CUE  TO  STEP  INPUT  (30V) 
PAGE  MERGE 

♦  PAGE  XYPLOT 

END 

STOP 

ENDJOB 

/* 
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